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DESCRIPTION 
ROBOT CONTROL APPARATUS AND ROBOT SYSTEM 



[Technical Field] 

This invention relates to a robot in a teaching 
playback system, and more particularly to a robot control 
apparatus for assuring safety of a worker or operator 
during working in access to a robot by limiting a pendant 
operation of a teacher in access to the robot during 
teaching, or the operation of the robot not watched 
carefully by the worker or operator. 

[Background Art] 

Now referring to the drawing, an explanation will 
be given of a conventional robot control apparatus. Fig. 
12 is a view showing the configuration of the conventional 
robot control apparatus. 

In Fig. 12, reference numeral 101 denotes a robot 
connected to a robot control apparatus 105. A working 
tool 102 for working is attached to the tip of a wrist 
of the robot 101. The robot control device 105 is 
connected to a pendant 106 employed to conduct the editing 
such as registering of a working program, or changing 
of a registered working program by operating the robot 
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101, performing registering of a position thereof or 
registering of a work. The robot control apparatus 
includes a safety shelf surrounding the operating range 
of the robot 101, a safety shelf door 108 to a gateway 
5 to the safety shelf, and a safety shelf door 
opening/closing detecting device 109 for detecting the 
opened/closed status of the safety shelf door 108. The 
safety shelf door opening/closing device 109 is connected 
to the robot control deice 105. 
10 The working is done by controlling the robot 101 

in a manner of moving the working tool 102 on the basis 
of the above working program for a work 104 fixed to a 
work holding device 103 installed in the vicinity of the 
robot 101. 

15 In the position registering of the robot 101 which 

is a part of the working program, a teacher manipulates 
the pendant 106 to operate the robot 101 so that the working 
tool 102 attached to the wrist is positioned at a prescribed 
position relative to the work 104 and the position is 

20 registered in a storage member not shown within a robot 
controlling device through the operation of the pendant 
106. The changing of the registered position of the robot 
101 can be executed likewise. 

In order to assure the safety of the teacher, the 

25 procedure in teaching will be explained below. 
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The teacher changes the operation mode of the robot 
into a teaching mode and opens the safety shelf door 108 
to enter the safety shelf 107. 

As regards the operation mode of the robot 101, its 
5 maximum operating speed of the robot in the teaching mode 
is limited by informing the robot control apparatus of 
the facts that the operation mode is in the teaching mode 
andthe safety shelf door opening/closing detecting device 
109 is producing an opened status signal of the safety 
10 shelf door 108. 

The maximum operating speed in this teaching mode 
is limited to limited to 250 mm/sec in an end effect unit. 

Next, in positioning the working tool 102 to a 
prescribed position of the work 104, the robot 101 is 
15 operated by manipulating the pendant. At this time, the 
teacher must pay an attention to the robot 1, working 
tool 102, work holding device 103, work 104 and peripheral 
devices of these components. 

In order to assure the safety of the teacher himself 
20 from the operation of the robot 101 not intended by the 
teacher due to an erroneous manipulation of the pendant 
106, the maximum operating speed in the teaching mode 
is limited. Thus, the teacher performs the teaching at 
a position apart from the robot 101 or work 104 so that 
25 he can perform an evading action against the inadvertent 
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operation of the robot 101 during teaching. 
(Prior Art 1) 

However, according to the shape and size of the work 
104, the shape of the working tool 102, an the arrangement 
5 of the work holding device 103 and peripheral devices, 
as the case may be, the teacher must comes near the robot 
101 or work 104 for teaching. In a conventional robot 
control apparatus, insuchacase, in order that the teacher 
can take an evading action against the inadvertent 

10 operation of the robot 101 due to the erroneous 
manipulation, setting of the pendant 106 is made to reduce 
the maximum operating speed of the robot 101 . Thereafter, 
the teacher performs the teaching. 

On the other hand, in a product manufacturing factory 

15 where a plurality of robots are installed, the teaching 
for the robots is individually performed. However, as 
the case may be, a plurality of persons simultaneously 
perform the teaching in order to reduce the teaching time. 
In this case, the individual teacher pays an attention 

20 to the movement of the robot which is an object for teaching 
and a working tool attached to the robot or their 
interference with the peripheral devices, but pays less 
attention to the robot which is not an object for teaching 
and its peripheral devices. 

25 Also in the case where the plurality of robots are 
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controlled by a single robot control apparatus, as in 
the case described above, less attention is paid to the 
matters which are not the object for teaching. 

If the operator stands outside the operation region 
5 of each robot, no interference occurs between the operator 
and the robot. However, where the teaching area difficult 
to confirm visually is taught or the point of teaching 
is finely adjusted, the operator comes near the robot. 
In the large-scale product manufacturing factory, the 

10 plurality of robots come near one another. Therefore, 
when the operator accesses a certain robot, he will enter 
the operation region of the other robots. 

In such a case, between the first operator teaching 
the first robot and the second operator teaching the second 

15 robot, because of the operation based on the subjective 
impression or carelessness by the second operator, the 
second robot may give serious injury to the first operator 
through the operation directed to the first operator who 
stands within the operation region of the second robot 

20 or interference and collision with him. 

Also in a production system in which a plurality 
of robots are controlled by a single robot control 
apparatus, where an operator performs teaching in an 
operating range of the plurality of robots, because of 

25 the operation based on the subjective impression or 
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carelessness by the operator, as in the case, there is 
a danger that the robot which is not the object for teaching 
gives serious injury to the operator through the operation 
directed to the operator and or interference and coll ision 
5 with him. 

(Prior Art 2) 

In a conventional robot control apparatus, these 
inconveniences was dealt with by interrupting the power 
source of driving the other robot than the operating obj ect , 

10 thereby braking each of axial motors. 
(Prior Art 3) 

As still another prior art, the Unexamined Japanese 
Patent Application Publication No. Heill-165291 
discloses a method in which while an industrial robot 

15 is operating, when a man or object enters the operating 
range of a robot, this is detected by a sensor, and a 
warning is issued to prevent an accident from occurring. 
(Prior Art 4) 

Further, the Unexamined Japanese Patent Application 

20 Publication No. HeilO-264080 discloses a method in which 
an operation abnormality detecting index for detecting 
abnormality in a moving speed, a moving acceleration, 
moving direction and moving position or abnormality in 
the angular speed of a wrist axis is created by CPU, and 

25 when the abnormality is detected as a result of comparison 
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of the detecting index with a reference value, a robot 
is stopped. 

In the prior art 1, when the teacher performs the 
teaching for the robot in access thereto, because of his 
5 desire in the improvement in an operation efficiency and 
forgetting of setting, as the case may be, he may operate 
the robot and perform the teaching therefor without 
reducing the maximum operating speed of the robot. In 
this case, if the pendant is erroneously manipulated, 
10 the robot makes the operation not intended by the teacher 
so that the teacher is surprised. Where the robot further 
comes near the teacher, he does not have a time to evade 
it . 

The prior art 2 provides the method for surely not 
15 operating the robot by the brake attached to each axis 
by interrupting the driving power source of the other 
robot than the object for teaching. However, a plurality 
of persons cannot simultaneously perform the teaching 
in order to shorten the teaching time. This leads to a 
20 possibility of difficulty in startup of a product 
manufacturing factory . Further, it i s actual ly impossible 
to teach the working by cooperation by a plurality of 
robots . 

The prior art 3 provides a method for preventing 
25 an accident from occurring by issuing a warning when the 
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person or object enters the operation range of the robot 
while the robot is operating. This method, if the robot 
is operating for product manufacturing, is an efficient 
means. However, during teaching, the operator 

5 frequently performs the teaching in the operation region 
of the robot. Therefore, whenever the warning is issued, 
the operation for continuing the teaching such as a 
releasing operation is required, thus leading to 
attenuation of the teaching efficiency. 

10 The prior art 4 provides a method of detecting that 

the robot has made an abnormal operation to stop the robot. 
This abnormal operation is the movement to the direction 
different from a designated direction and deviation from 
a designated path. This method detects such abnormal 

15 operation to stop the robot. Further, the abnormal 
operation will occur owing to the erroneous operation 
of components within the control apparatus due to the 
temperature environment and electromagnetic environment 
around the robot or the interference status between the 

20 robot and peripheral devices. This method is an efficient 
means for preventing the abnormal operation from 
continuing. However, the operation not intended by the 
operator of the robot in a teaching scene is mainly 
attributable to the erroneous operation. When the 

25 erroneous operation occurs, the robot control apparatus 
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cannot determine whether or not the designated moving 
speed and moving path of a robot control point have been 
intended by the operator. Thus, the detection in this 
system is made impossible, thereby making it impossible 
5 to stop the robot before the robot gives an injury to 
the operator. 

As described above, the conventional robot control 
apparatus has a problem that it is difficult to assure 
the safety of the operator when performing the teaching 
10 involved with the robot operation in access to the robot. 

[Disclosure of the Invention] 

In view of these problems, this invention is 
accomplished. An object of this invention is to provide 

15 a robot control apparatus which can enhance the safety 
of a teacher by detecting the teaching in access to a 
robot to automatically reduce the operating speed of the 
robot, and assuring the time for an evading action to 
the teacher when the robot operates at the direction or 

20 speed not intended by the teacher owing to the erroneous 
manipulation of a pendant. 

Another object of this invention is to provide a 
robot control apparatus capable of building a robot system 
which can assure the safety of an operator by limiting 

25 the operation of the other robot than the robot for teaching 
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so that an operator is not given an injury from the other 
robot than the robot for teaching owing to the erroneous 
operation by another operator in a situation where a 
plurality of robots are arranged closely, and issuing 
5 a warning or alarm to pay an attention to the operator. 

In order to solve the problems described above, this 
invention is constructed as follows. 

The invention described in claim 1 is a robot control 
apparatus equipped with a pendant to be manipulated by 
10 a teacher, for controlling the operation of a robot on 
the basis of an operation command from the pendant, 
characterized by including: 

a detecting device for detecting the position of 
the teacher; 

15 a signal processing unit for receiving a signal from 

the detecting device to produce the position information 
of the teacher; and 

a limited speed selecting unit for selecting the 
operating speed of the robot on the basis of the position 
20 information, wherein 

the robot is controlled at the maximum operating 
speed selected by the limited speed selecting unit on 
the basis of the operation command from the pendant. 

In accordance with this configuration, by reducing 
25 the maximum operating when a teacher accesses the robot, 
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a robot with great safety can be provided which permits 
the operator to take an evading action for a non-intended 
action of the robot. 

The invention described in claim 2 is a robot control 
5 apparatus equipped with a pendant to be manipulated by 
a teacher, for controlling the operation of a robot on 
the basis of an operation command from the pendant and 
a detected position in a position detector attached to 
each axis, characterized by including: 

10 a robot position computing unit for computing the 

coordinate position of the robot on the basis of the 
detected position; and 

a limited speed selecting unit for selecting the 
operating speed of the robot on the basis of an output 

15 from the robot position computing unit, wherein 

the robot is controlled at the maximum operation 
selected by the limited speed selecting unit on the basis 
of the operation command from the pendant. 

In accordance with this configuration, since the 

20 maximum operating speed of the robot can be varied 
according to the position of the robot when the teacher 
accesses the robot, by reducing the maximum operating 
speed when a working tool attached to the robot is near 
the teacher, attenuation of the working efficiency of 

25 the teaching can be minimized. 
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The invention described in claim 3 is a robot control 
apparatus equipped with a pendant to be manipulated by 
a teacher, for controlling the operation of a robot on 
the basis of an operation command from the pendant and 
a detected position by a position detector attached to 
each axis, characterized by including: 

a detecting device for detecting the position of 
the teacher; 

a signal processing unit for receiving a signal from 
the detecting device to produce the position information 
of the teacher; 

a robot position computing unit for computing the 
coordinate position of the robot on the basis of the 
detected position; and 

a limited speed selecting unit for selecting the 
operating speed of the robot on the basis of outputs from 
the signal processing unit and the robot position 
computing unit, wherein 

the robot is controlled at the maximum operating 
speed selected by the limited speed selecting unit on 
the basis of the operation command from the pendant. 

In accordance with this configuration, since the 
maximum operating speed of the robot can be varied 
according to the position of the robot when the teacher 
comes near the robot, by reducing the maximum speed at 
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a working position, decreased is a chance for a working 
tool and work to be injured by interference between the 
working tool and work attributable to the not-intended 
operation of the robot by an erroneous operation. 

The invention described in claim 4 is a robot control 
apparatus equipped with a pendant to be manipulated by 
a teacher, for controlling the operation of a robot on 
the basis of an operation command from the pendant and 
a detected position in a position detector attached to 
each axis, characterized by including: 

an input unit for inputting a position monitoring 
signal for monitoring the position of the robot; 

a position storage member for storing the detected 
position when the position monitoring signal is inputted; 

a permitted value storage member for storing a 
prescribed permitted range of the operation of each the 
axis; 

a position difference computing member for computing 
a position difference between the detected position and 
the detected position stored in the position storage 
member ; and 

a comparing member for comparing the position 
difference and the permitted range, wherein 

while the position monitoring signal is inputted, 
if the position difference exceeds the permitted range 
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as a result of comparison in the comparing member, the 
operation of the robot is stopped. 

In accordance with this configuration, when the 
operator accesses the other robot to which he does not 
pay his attention, by monitoring the pos ition of the other 
robot, a robot with great safety can be provided in which 
the operator will not be injured by the other robot. 

The invention described in claim 5 is a robot control 
apparatus equipped with a pendant to be manipulated by 
a teacher, for controlling the operation of a robot on 
the basis of an operation command from the pendant and 
a detected position in a position detector attached to 
each axis, characterized by including: 

an input unit for inputting a position monitoring 
signal for monitoring the position of the robot; 

a position storage member for storing the detected 
position when the position monitoring signal is inputted; 

a permitted value storage member for storing a 
prescribed permitted range of the operation of each the 
axis; 

a position difference computing member for computing 
a position difference between the detected position and 
the detected position stored in the position storage 
member; and 

a comparing member for comparing the position 
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difference and the permitted range, wherein 

while the position monitoring signal is inputted, 
the detected position is stored after comparison has been 
made by the comparing member, and if the position 
5 difference exceeds the permitted range as a result of 
comparison in the comparing member, the operation of the 
robot is stopped. 

In accordance with this configuration, when the 
operator accesses the other robot to which he does not 

10 pay his attention, by monitoring the other robot at a 
prescribed speed, the teaching for the other robot can 
be continued, and the robot with great safety can be 
provided in which the operator will not be injured by 
the other robot. 

15 The invention described in claim 6 is a robot control 

apparatus equipped with a pendant to be manipulated by 
a teacher, for controlling the operation of a robot on 
the basis of an operation command from the pendant and 
a detected position by a position detector attached to 

20 each axis, characterized by including: 

a robot position computing unit for computing the 
coordinate position of the robot on the basis of the 
detected position; 

an input unit for inputting a position monitoring 

25 signal for monitoring the position of the robot; 
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a position storage member for storing the coordinate 
position when the position monitoring signal is inputted; 

a permitted value storage member for storing a 
prescribed permitted range of the operation of each the 
5 axis; 

a position difference computing member for computing 
a position difference between the coordinate position 
and the coordinate position stored in the position storage 
member; and 

10 a comparing member for comparing the position 

difference and the permitted range, wherein 

while the position monitoring signal is inputted, 
if the position difference exceeds the permitted range 
as a result of comparison in the comparing member, the 

15 operation of the robot is stopped. 

The invention described in claim 7 is a robot control 
apparatus equipped with a pendant to be manipulated by 
a teacher, for controlling the operation of a robot on 
the basis of an operation command from the pendant and 

20 a detected position by a position detector attached to 
each axis, characterized by including: 

a robot position computing unit for computing the 
coordinate position of the robot on the basis of the 
detected position; 

25 an input unit for inputting a position monitoring 
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signal for monitoring the position of the robot; 

a position storage member for storing the coordinate 
position when the position monitoring signal is inputted; 

a permitted value storage member for storing a 
5 prescribed permitted range of the operation of each the 
axis; 

a position difference computing member for computing 
a position difference between the coordinate position 
and the coordinate position stored in the position storage 
10 member; and 

a comparing member for comparing the position 
difference and the permitted range, wherein 

while the position monitoring signal is inputted, 
the coordinate position is stored after comparison has 
15 been made by the comparing member, and if the position 
difference exceeds the permitted range as a result of 
comparison in the comparing member, the operation of the 
robot is stopped. 

In accordance with these configurations, the range 
20 of position monitoring or speed monitoring can be set 
on a coordinate system of the robot . Thus, setting values 
can be determined on the basis of the information of 
arrangement of the robot before the robot system is built, 
thereby reducing the working time required for installing 
25 the robot system. 
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The invention described in claim 8 is a robot control 
apparatus, characterized in that 

the robot is equipped with a teaching device, and 
the permitted range can be set by the teaching device 
or an external control device through a predetermined 
interface included in the robot control apparatus. 

In accordance with this configuration, various 
settings for the position control or speed control of 
the robot can be made by the teaching device, or made 
by the external control device having the information 
on the robot system. 

The invention described in claim 9 is a robot control 
apparatus characterized in that 

if the position difference exceeds the permitted 
range, abnormality display or warning display is made 
on the teaching device. 

The invention described in claim 10 is a robot control 
apparatus characterized in that 

it is provided with an output unit, and if the 
position difference exceeds the permitted range, 
abnormality display or warning display is outputted 
outside the robot control apparatus. 

In accordance with these configurations, if the 
permitted range is exceeded in the position monitoring 
or speed monitor ing, abnormality or warning can be issued 
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so that the teacher's attention is called, thereby 
enhancing safety conscientiousness. 

The invention described in claim 11 isa robot control 
apparatus characterized in that 

the coordinate position data is a spatial position 
data at a tip of combined arms of the robot; and 

the tip is a tip position of a tool whose tool size 
is known. 

In this configuration, the position monitoring or 
speed monitoring of the working tool can be done. 

The invention described inclaim 12 isarobotcontrol 
apparatus char act eri zed in that 

the operation of the robot is stopped by making the 
operation command to each the axis zero, or interrupting 
driving energy to the robot . 

In accordance with this configuration, if the 
permitted range is exceeded in the position control or 
speed control of the robot, the robot is stopped, thereby 
preventing expansion of injury. 

The invention described in claim 13 is a robot system 
in which a plurality of robots are operated by a plurality 
of mans so as to permit the position or speed of each 
robot to be monitored by inputting a position monitoring 
signal through an input unit of a robot control device, 
characterized in that 
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inputting of the position monitoring signal 
identifies that another operator operating another robot 
has entered a predetermined region of a certain robot 
being operated by an operator, thereby monitoring the 
5 position or speed of the robot. 

In this robot system, when the teacher comes near 
a robot for which teaching is not performed in teaching 
a plurality of robots, the position monitoring or speed 
monitoring of the robot is done so that a system with 

10 great safety not injuring the teacher can be built. 

As understood from the above explanation, in 
accordance with the robot control apparatus according 
to this invention, while a teacher performs the teaching 
in access to a robot or work holding device or within 

15 the operation range of the robot, even if the operation 
of the robot not intended by the teacher occurs owing 
to the erroneous manipulation of the pendant, since the 
robot is controlled at a low speed, the time enough for 
the teacher to take an evading action can be assured, 

20 thereby providing the effect of enhancing safety of the 
teacher. 

Further, only if the wrist of the robot or working 
tool comes near the teacher, the maximum operating speed 
of the robot is reduced so that safety of the teacher 
25 can be enhanced . Inaddition, since the maximum operating 
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speed of the robot is increased at a position remote from 
the working position by the robot, i.e. the teacher, 
attenuation of the teaching efficiency can be minimized. 

Further, in accordance with this invention, in a 
situation where a plurality of robots are arranged closely, 
while the operator is performing the teaching for a robot 
which is an object for teaching, it is detected that he 
has entered the operating range of the robot which is 
not the object for operation or working and dangerous 
region attributable to the operation of the robot. The 
position of the robot at the time of detection is stored, 
and compared with the difference permitted value 
previously set. If the difference exceeds the permitted 
value, the robot is stopped, or its operating speed is 
limited, thereby proving the effect capable of the 
production system with robots with very great safety. 

Where the operation of the robot is limited, the 
abnormality display or warning display of the robot is 
made on the pendant . In addition, since the robot control 
device issues the abnormality output or warning output, 
not only the operator but also the workers in the vicinity 
of him can know that there has been a chance to encounter 
the danger, thereby providing the effect of contribution 
to enhancing safety conscientiousness. 
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[Brief Description of the Drawings] 

Fig. 1 is a view of the configuration of a robot 
system illustrating a first embodiment of this invention. 

Fig. 2 is a block diagram of speed control according 
5 to this invention. 

Fig. 3 is a view of the configuration of a robot 
system illustrating a second embodiment of this invention . 

Fig. 4 is a block diagram of the second embodiment 
of this invention. 
10 Fig. 5 is a block diagram of a third embodiment of 

this invention. 

Fig. 6 is a view of the configuration of a robot 
system illustrating a fourth embodiment of this invention . 

Fig. 7 is a block diagram of the control unit in 
15 the robot control apparatus in the fourth embodiment of 
this invention. 

Fig. 8 is a processing flowchart in the fourth 
embodiment of this invention. 

Fig. 9 is aprocessing flowchart ina fifth embodiment 
20 of this invention. 

Fig. 10 is a view of the configuration of a robot 
system illustrating a seventh embodiment of this 
invent ion . 

Fig. 11 is a connecting view of an operator detecting 
25 control apparatus in the seventh embodiment of this 
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invention . 

Fig. 12 is a view showing the configuration of a 
conventional robot control apparatus. 

5 [Best Mode for Carrying Out the Invention] 

Now referring to the drawings, an explanation will 
be given of various concrete embodiments of this 
invention . 
(Embodiment 1) 

10 Fig. 1 is a view of the configuration of a robot 

system illustrating a first embodiment of this invention. 

In Fig. 1, reference numeral 1 denotes a robot 
connected to a robot control apparatus. A working tool 
2 for working is attached to the tip of a wrist of a robot 

15 1. The robot control device is connected to a pendant 
10 employed to conduct the editing such as registering 
of a working program, or changing of a registered working 
program by operating the robot 1, performing registering 
of a position thereof or registering of a work. The robot 

20 control apparatus includes a safety shelf surrounding 
the operating range of the robot 1, a safety shelf door 
6 to a gateway to the safety shelf, and a safety shelf 
door opening/closing detecting device 7 for detecting 
the opened/closed status of the safety shelf door 6. An 

25 output signal from the safety shelf door opening/closing 
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device 7 is connected to the robot control device 9. 

A detecting device 8 is installed in the vicinity 
of the robot 1 and a work holding device 3. An output 
signal from the detecting device 8 is connected to the 
robot control device 9. The detecting device 8, when 
pressure higher or lower than a prescribed value is 
detected, supplies a signal to the robot control 9. This 
detecting device 8 may be e.g. a safety mat. 

A robot system, before it operates, sets a first 
maximum operating speed and a second maximum operating 
speed in a teaching mode by the operation of the pendant 
10 by a robot system structurer. These speeds are stored 
in a storage member not shown. 

The second maximum operating speed is lower than 
the first maximum operating speed. The first maximum 
operating speed is usually 250 mm/sec, but may be lower 
than this value according to the condition such as the 
use and robot operating range. 

The operation of the robot 1 in the teaching mode, 
and registering of its position and changing of the 
registered position are executed in the same as the prior 
art described above. 

Fig. 2 is a block diagram showing speed control for 
executing this invention. The detecting device 8 serves 
to detect the position of a teacher. A signal from the 
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detecting device 8 is supplied to a signal processing 
unit 11 . The signal processing unit 11 supplies the signal 
read from the detecting device 8 to a limited speed 
selecting unit 12. The limited speed selecting unit 12 
5 supplies, to a speed calculating unit 14, the limited 
speed selected according to the signal statue acquired 
from the signal processing unit 11 and operating mode 
designated from an operating unit not shown. By the 
manipulation of the pendant 10 by the teacher, the pendant 

10 10 supplies an operating command to the speed calculating 
unit 14. The speed calculating unit 14 compares the 
limited speed supplied from the limited speed selecting 
unit 12 and the taught speed obtained from the operating 
command from the pendant 10. If the limited speed > the 

15 taught speed, the speed override ratio = 1 is supplied 
to a command creating unit 15. If the limited speed < 
the taught speed, the speed override ratio = limited 
speed/taught speed is supplied to the command creating 
unit 15. The command creating unit 15 reads the taught 

20 data stored in the taught data storage area 13 and 
corresponding to the operating command from the pendant 
10, acquires the operating speed obtained from the taught 
speed of the taught data supplied by the speed override 
ratio supplied from the speed calculating unit 14 and 

25 supplies the operating command created to realize this 



26 



operating speed to a driving unit 16. The driving unit 
1 6 performs the servo driving control by means of a position 
controller, speed controller, current amplifier, etc., 
thereby operating the robot 1. 

In the teaching mode, when the robot 1 is operated 
through the manipulation of the pendant 1, in order to 
operate the robot 1 largely, the operator can manipulate 
the pendant 10 outside the operating range of the robot 
1. For this reason, even when an inadvertent operation 
of the robot occurs owing to an erroneous manipulation, 
since the maximum operating speed of the robot 1 in the 
teaching mode is limited by the first maximum speed, the 
teacher can take an evading action. Further, since the 
teacher is present outside the operating range of the 
robot 1, the teacher will be not injured by the robot 
1 . 

Now, where the teacher performs the teaching in a 
nearer position to the robot 1, work holding device 3 
or work 4 according to the shape and size of the work 
4, shape of the working tool 2 and arrangement of the 
work holding device 3 and peripheral devices, the teacher 
is present on the detecting unit 8 so that his weight 
is applied to the detecting unit 8. Thus, the detecting 
unit 8 detects the resultant stress and supplies the 
corresponding signal to the robot control device 9. 
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The robot control device 9 takes the signal from 
the detecting device 8 in the signal processing unit 11 
through a signal input device not shown. The result 
therefrom is supplied to the limited speed selecting unit 
12. Before the operation, the limited speed selecting 
unit 12 supplies the second maximum operating speed stored 
in the storage member not shown to the speed override 
ratio calculating unit 14. The override ratio calculating 
unit 14 calculates the speed override ratio with the second 
maximum operating speed as the limited speed on the basis 
of the speed data supplied from the taught data storage 
area 13. The command creating unit 15 creates the 
operating command to give the operating speed of the speed 
data from the taught data storage area 13 multiplied by 
the speed override ratio calculated, thereby operating 
the robot 1 through the driving unit 16. The driving unit 
16 includes a servo amplifier and servo motor which are 
employed to drive the manipulator. 

Thus, the robot 1 operates at a speed lower than 
the second maximum operating speed. 

For this reason, the maximum operating speed of the 
robot while the teacher performs the teaching in access 
to the robot 1, work holding 3 or work 4 is the second 
maximum operating speed. Thus, in this status, even when 
the operation of the robot 1 not intended by the teacher 
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occurs owing to the erroneous manipulation of the pendant 
10, the teacher can take the evading action. 
(Embodiment 2 ) 

Fig. 4 is a block diagram of speed control according 
5 to the second embodiment of this invention. A driving 
unit 16 is provided with a position detector capable of 
detecting a position. On the basis of the signal from 
this position detector, a robot position calculating unit 
17 calculates the present position of the robot. 

10 The limited speed selecting unit 12 selects the maximum 
speedonthebasisofthe outputs from the signal processing 
unit 11 and robot position calculating unit 17 . The manner 
of selection will be explained below on the basis of a 
configuration view . 

15 Fig. 3 is a view showing the configuration of a robot 

system showing the second embodiment of this invention. 

In Fig. 3, reference numeral 1 denotes a robot 
connected to a robot control device 9. A work 4a and a 
work 4b for which working is to be carried out are arranged 

20 on the left and right side of the robot 1, respectively. 
Reference numerals 8a and 8b denote a plurality of 
detecting devices. When a predetermined pressure or 
lower is applied to the detecting devices 8a and 8b, these 
detecting devices supplies a signal to the robot control 

25 device 9, respectively. In Fig. 3, the working tool , work 
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holding device, safety shelf , and other peripheral devices 
are not illustrated. 

The robot system, before it operates, sets a first 
maximum operating speed, a second operating speed and 
5 a third operating speed in a teaching mode by the 
manipulation of the pendant 10 by a robot system builder. 
These speeds are stored in a storage member not shown 
of the robot control device 9. 

The second and third maximum operating speeds are 
10 set at lower than the first maximum operating speed. The 
first maximum operating speed is usually 250 mm/sec, but 
may be lower than this value according to the condition 
such as the use and robot operating region. 

The operation of the robot 1 in the teaching mode, 
15 and registering of its position and changing of the 
registered position are executed in the same as the prior 
art described above. 

The working by the robot 1 requires the teaching for the 
work 4a and the teaching for the work 4b. Therefore, the 

20 teaching for the work 4a gives a chance of teaching to 
the teacher in access to the work 4b. Likewise, the teaching 
for the work 4b gives a chance of teaching to the teacher 
in access to the work 4a. 

In the teaching in access to the work 4a or work 

25 4b, the teacher performs the teaching on the detecting 
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device 8a or detecting device 8b. Therefore, the 
detecting device 8a or 8b supplies a signal to the signal 
processing unit 11 of the robot control device 9. The 
result obtained therefrom is supplied to the limited speed 
selecting unit 12. 

The robot control device 9 knows the position of 
an end effecter of the robot 1 on the basis of the 
information from thepositiondetectorof each servo axis. 
In response to the output from the signal processing unit 
1 1 having processed the signal supplied from the detecting 
device 8a or 8b, the limited speed selecting unit 12 selects 
the limited speed as follows. 

1) If the signal is produced from the detecting device 
8a and the end effecter of the robot 1 is located on the 
side nearer to the work 4a than to the center of the robot 
1, the limited speed is set at the third maximum operating 
speed . 

2) If the signal is produced from the detecting device 
8b and the end effecter of the robot 1 is located on the 
side nearer to the work 4a than to the center of the robot 
1, the limited speed is set at the second maximum operating 
speed. 

3) In a case other than the cases 1) and 2) , the limited 
speed is set at the first maximum operating speed. 

The limited speed thus selected is supplied to the 
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speed override ratio calculating unit 14. Thus, the robot 
1 is controlled so that it operates at the speed lower 
than the limited speed thus set. 
(Embodiment 3) 

5 Now refer ring to Fig . 5, an explanation wi 1 1 be given 

of the third embodiment of this invention. The third 
embodiment intends to control the operating speed of the 
robot 1 on the basis of only the present position of the 
robot computed by the robot position computing unit 17. 

10 The speed limited region in a robot operating range 

and the maximum oper at ing speed in the speed limited region 
are stored in a storage area not shown. 

The speed limited region can be defined in such a 
manner that the robot 1 is operated to register two end 

15 points, or the coordinate values of robot coordinates 
are registered by direct inputting from the pendant. 
These manners permit a rectangular parallelepiped to be 
defined on the robot coordinates. 

In the robot control device 9, the position of the 

20 end ef fecter of the robot 1 is periodically computed by 
the robot position computing unit 17 using the information 
from the position detector of each servo axis. If this 
position is within the speed limited region, the 
corresponding operating speed is selected by the limited 

25 speed selecting unit 12 and the operating speed thus 



32 

• • 
t 

/ 

selected is supplied to the speed calculating unit 14. 

On the pendant 10, a speed key for selecting one 
of three or so taught speeds of a robot is arranged. By 
depressing the speed key, the teacher can select a desired 
5 taught speed of the robot. 

If the teacher desires to operate the robot in the 
+ axis direction of the robot coordinates, he depresses 
the key of designating the movement to + X on the pendant. 
The pendant 10 informs the speed calculating unit 14 of 

10 depressing the +X key. 

The speed calculating unit 14 creates a speed command 
according to the taught speed set at present. In this 
case, the speed calculating unit 14 compares the speed 
command Vp created on the basis of the command from 1 the 

15 pendant 10 and the speed Vs selected by the limited speed 
selecting unit 12. As a result of comparison, if Vp > 
Vs, the speed calculating unit 14 supplies the speed 
command of Vs to the command creating unit 15. If Vp < 
Vs, the speed calculating unit 15 supplies the speed 

20 command of Vp to the command creating unit 15. 

It is also possible to set a plurality of speed 
limited regions. Further, it is possible to display the 
maximum speed selected by the pendant 10 so that the teacher 
can confirm the maximum speed. 

25 In this way, the operating speed of the robot will 
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not exceed the speed selected by the limited speed 
selecting unit 12. 
(Embodiment 4 ) 

Where the working for a work is carried out by the 
5 robot, the working can be done by a single robot, but 
as the case may be, the working may be done by cooperation 
of a plurality of robots considering the working 
efficiency, direct ion conversion of the work, preparation 
of the work on a working table and removal of the work 

10 from the working table after working. 

Fig. 6 is a view of the configuration of the robot 
system according to this embodiment. 

In Fig. 6, reference numeral 21 denotes a robot 
connected to a robot control device 22 . The robot control 

15 device 22 is connected to a first pendant 23 employed 
to conduct the editing such as registering of a working 
program, or changing of a registered working program by 
operating the first robot 21, performing registering of 
a position thereof or registering of working by the 

20 manipulation in the teaching. A working tool, which is 
attached to the tip of the wrist of the first robot 21, 
executes the working by implementing the above working 
program for the work 24 on the working table 25. On the 
other hand, reference numeral 26 denotes a second robot 

25 connected to a second robot control device 27 to which 
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a second pendant 28 is connected. Reference numeral 31 
denotes an operator detector for detecting that a first 
operator 29 has entered the operating range of the second 
robot 26 or a dangerous region due to the operation of 
the second robot 26 while he performs the teaching for 
the first robot 21, thereby supplying a position 
monitoring signal to the second robot control device 27. 

In order that the operator does not enter the 
operating range of the two robots while the working for 
the work 24 based on the working programs by the two robots 
is performed, the operating range of the two robots are 
surrounded by a protection shelf not shown. 

Where the teaching for the two robots is performed, 
within the protection sh elf, the first operator 2 9 attends 
to the teaching for the first robot 21 whereas a second 
operator 30 attends to the teaching for the second robot 
26. When the first operator 29 approaches the work 24 
for the purpose of teaching of the details of the work 
24, he will enter the operating range of the second robot 
26. Thus, the operator detector 31 detects this fact, 
thereby supplying a detected signal to the second robot 
control device 27. In response to this detected signal, 
the second robot control device 27 limits the operation 
of the second robot 26. 

The operator detector 31 may be any one of a safety 
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mat, a sonic object detector and an optical object 
detector. 

An explanation will be given of the operation of 
the second robot 2 6. Fig. 7 is ablockdiagramof a control 

5 unit of the robot control device, a driving power source 
device, a driving circuit and a motor. 

In Fig. 7, in the control unit 41, on the basis of 
a control program stored in a control program storage 
member 43, a CPU 42 executes the unified control of the 

10 robot including creation of a driving command for each 
of motors 52-1, ... 52-n of the second robot. Reference 
numeral 44 denotes a data storage member which is employed 
to write or read the data necessary for robot control. 

A driving power source interface 46 included in the 

15 control unit 41 is connected to a driving source device 
50 connected to a power source so that it controls the 
supply or interruption of the driving power to driving 
circuits 51-1, ... 51-n which are connected to the driving 
power source device 50 so as to receive the driving power. 

20 The driving circuits 51-1, ... 51-n are connected to the 
motors 52-1, ... 52-n so that they control the driving of 
the motors 52-1, ... 52-n under the control by the driving 
circuit interface 49 included in the control unit 41. 
Position detectors 53-1, ... 53-n are attached to the motors 

25 52-1, ... 52-n so that they supply detected positions of 
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the motors 52-1, ... 52-n to position detector interfaces 
45-1, ... 45-n included in the control unit 41, respectively. 
The detected positions are employed for the driving 
control of the motors 52-1, ... 52-n. 
5 The control unit 41 further includes an input unit 

47-1 and output unit 47-2 for executing signal 
input/output between the second robot control device 27 
and the outside, and a pendant interface for executing 
signal exchange for the second pendant 28. 

10 The input unit 47-1 is assigned a position monitoring 

signal from the operator detector 31 and the output unit 
47-2 is assigned an abnormal output or a warning output 
for the outside. 

The data storage member 44 receives the detected 

15 positions from the position detectors 53-1, ... 53-n 
attached to the motors 52-1, ... 52-n through the position 
detector interfaces 45-1, ... 45-n, and stores them in a 
position storage area 44-1 at predetermined timings. A 
position difference between the detected position 

20 received at a predetermined period and the detected 
position already stored in the position storage area 44-1 
is computed. The computed position difference is 
compared with a position difference perm ittedvalue stored 
in a permitted value storage area 44-2. If the computed 

25 position exceeds the difference permitted value, the 
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driving current to the motors 52-1, ... 52-n is controlled 
through the driving circuit interface 49 so that the 
driving command to the motors 52-1, ... 52-n is made zero, 
thereby stopping the second robot 26. Otherwise, the 
5 driving power source device 50 is controlled through the 
driving power source device interface 4 6 so as to interrupt 
the driving power source necessary to drive the motors 
52-1, ... 52-n, thereby stopping the second robot 26. In 
addition to stopping the second robot 26, abnormality 
10 display or warning display is made on the second pendant 
28 through the pendant interface 48. Further, 
abnormality output or warning output can be made outside 
the second robot control device 27 through the output 
unit 47-2 . 

15 Incidentally, the position difference permitted 

values are inputted in the permitted value storage area 
44-2 through the pendant interface 48 by manipulating 
the second pendant 28. They can be set by an external 
control device through a serial interface (not shown) 

20 included in the control unit 41. 

Referring to the flowchart of Fig. 8 showing the 
embodiment of this invention, the operation described 
above will be explained in further detail. 

A position monitoring signal from the operator 

25 detector 31 is inputted through the input unit 47-1. 
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If there is the position monitoring signal, i.e. 
if the operator detector 31 detects that the first operator 
has entered the operating range of the second robot 26 
while he is performing the teaching for the first robot 
5 21, or entered the dangerous region attributable to the 
operation of the second robot 26, the operation proceeds 
to step 2. If not, the operation proceeds to End (Step 
1) . 

It is determined whether or not there is a rise in 
10 the position monitoring signal. If there is the rise in 
the position monitoring signal, the operation proceeds 
to step 3. If not, the operation proceeds to step 4. 
Whether or not the signal has risen canbe easily determined 
by the logical operation of the signal status read the 
15 last time and that read at this time (step 2) . 

The detected positions from the position detectors 
53-1, ... 53-n are read in through the position detector 
interfaces 45-1, ... 45-n and stored in the position storage 
area 44-1. The detected positions to be stored may be 
20 the values read for motor control, or may be the values 
converted for the position control of the motors (step 
3) . 

The detected positions from the position detectors 
53-1, ... 53-n are read in through the position detector 
25 interfaces 45-1 , ... 45-n (or may be the values already 
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read or converted as in step 3), and their differences 
from the detected positions stored in the position storage 
area 44-1 are computed (step 4) . 

The position differences computed in step 4 are 
compared with the difference permitted values stored in 
the permitted value storage area 44-2. If the position 
differences exceed the difference permitted values, the 
operation proceeds step 6. If not, the operation proceeds 
to End. 

The robot is stopped and display/output of 
abnormality or warning is also made. The robot can be 
stopped by stopping the mo tors 52-1, ... 52 -n with the driving 
power source being energized under the control by the 
driving circuit interface 49, or otherwise by interrupting 
the driving power source through the driving power source 
device 50 (step 6) . 

In accordance with this embodiment, while the 
operator is performing the working such as teaching, it 
is detected that he has entered the operating range of 
the robot which is not the object for working and dangerous 
region attributable to the operation of the robot. The 
position of the robot at the time of detection is stored, 
and compared with the difference permitted value 
previously set. If the difference exceeds the permitted 
value, the robot is stopped. Namely, since the operating 



40 



range of the robot is limited, the operator at issue can 
be protected from the danger from the operation of the 
robot due to the erroneous operation by the operator who 
is operating therobotwhichisnottheobject for operating 
or working. 

Where the operation of the robot is limited, the 
abnormality display or warning display of the robot is 
made on the pendant . In addition, since the robot control 
device issues the abnormality output or warning output, 
not only the operator but also the workers in the vicinity 
of him can know that there has been a chance to encounter 
the danger, thereby contributing to enhancing safety 
conscientiousness . 
(Embodiment 5) 

Next, the fifth embodiment of this invention will 
be explained. The configuration and block diagram of the 
robot control device and two-robot system, which are the 
same as those shown in Figs. 6 and 7, will not be explained 
in detail . 

Referring to the flowchart of Fig. 9 showing the 
fifth embodiment of this invention, the operation 
described above will be explained. 

A position monitoring signal from the operator 
detector 31 is inputted through the input unit 47-1. 

If there is the position monitoring signal, i.e. 
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if the operator detector 31 detects that the first operator 
has entered the operating range of the second robot 26 
while he is performing the teaching for the first robot 
21/ or entered the dangerous region attributable to the 
5 operation of the second robot 26, the operation proceeds 
to step 12. If not, the operation proceeds to End (Step 
11) . 

It is determined whether or not there is a rise in 
the position monitoring signal. If there is the rise in 
10 the position monitoring signal, the operation proceeds 
to step 13. If not, the operation proceeds to step 15 
(step 12) . 

The detected positions from the position detectors 
53-1, ... 53-n are read in through the position detector 
15 interfaces 45-1 , ... 45-n (or may be the values already 
read or converted as in step 3 in the fourth embodiment) , 
and converted into the coordinate system of the second 
robot 26 (step 13) . 

The position data on the coordinate system converted 
20 in step 13 are stored in the position storage area 44-1 
(step 14) . 

The detected positions from the position detectors 
53-1, ... 53-n are read in through the position detector 
interfaces 45-1 , ... 45-n (or may be the values already 
25 read or converted as in step 13), and converted into the 
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coordinate system of the second robot 26 (step 15). 

The position differences are computed between the 
position data on the coordinate system converted in step 
15 and the position data stored in the position storage 
5 area 44-1 (step 16). 

The position differences computed in step 16 are 
compared with the difference permitted values stored in 
the permitted value storage area 44-2. If the position 
differences exceed the difference permitted values, the 
10 operation proceeds step 1 8 . If not, the operation proceeds 
to End. 

The robot is stopped and display/output of 
abnormality or warning is also made. The robot can be 
stopped by stopping the mo tors 52-1, ... 52-n with the driving 

15 power source being energized under the control by the 
driving circuit interface 49, or otherwise by interrupting 
the driving power source through the driving power source 
device 50 (step 18) . 

In the fifth embodiment, the difference permitted 

20 value is stored in the permitted value storage area 44-2 
in the format of e.g. millimeter in terms of the position 
of each coordinate axis. In the fourth embodiment, the 
difference permitted value is stored in the permitted 
value storage area 44-2 in the format of e.g. pulses in 

25 terms of a motor position. 
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The fourth embodiment and fifth embodiment of this 
invention can be individually or simultaneously carried 
out, thereby achieving the same effect. 

In accordance with this embodiment, the same 
operational effect as the fourth embodiment can be 
obtained. Further, in accordance with this embodiment, 
since the difference permitted values to be previously 
set are inputted on the coordinate system of the robot 
in units of e.g. millimeter, they can be easily determined 
on the basis of an arrangement view of the robot. 
(Embodiment 6) 

In the flowchart of Fig. 8 in the fourth embodiment, 
between step 4 and step 5, a step is added for storing 
the detected positions read from the position detectors 
53-1, ... 53 -n though the position detector interfaces 45-1, 
... 45-n in step 4 in the position storage area 44-1. In 
this case, like the case described above, the detected 
positions to be stored may be the values read for motor 
control, or may be the values converted for the position 
control of the motors. 

Otherwise, in the flowchart of Fig. 9 in the fifth 
embodiment, between step 16 and step 17, a step is added 
for storing the detected positions read from the position 
detectors 53-1, ... 53-n though the position detector 
interfaces 45-1, ... 45-n in step 15 in the position storage 
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area 44-1 as the position data converted into the 
coordinate system of the second robot 26. In this case, 
like the case described above, the detected positions 
to be stored may be the values read for motor control, 
5 or may be the values converted for the position control 
of the motors . 

In accordance with this embodiment, while the 
operator is performing the working such as teaching, it 
is detected that he has entered the operating range of 

10 the robot which is not the object for working and dangerous 
region attributable to the operation of the robot. The 
position of the robot at the time of detection is stored, 
and compared with the difference permitted value 
previously set. If the difference exceeds the permitted 

15 value, the robot is stopped. Since the position data to 
be stored in the position storage area 44-1 are 
sequentially updated so that the operating speed of the 
robot is limited. Thus, the operator at issue can be 
protected from the danger from the operation of the robot 

20 due to the erroneous operation by the operator who is 
operating the other robot, and the operation of the other 
robot can be continued at the limited speed. 

Where the operating speed of the robot is limited, 
the abnormality display or warning display of the robot 

25 is made on the pendant. In addition, since the robot 
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control device issues the abnormality output or warning 
output, not only the operator but also the workers in 
the vicinity of him can know that there has been a chance 
to encounter the danger, thereby contributing to enhancing 
5 safety conscientiousness. 
(Embodiment 7) 

Fig. 10 is a concrete configuration view of two-robot 
system using this invention. 

In Fig. 10, like reference numerals refer to like 
10 parts in the configuration of the robot system showing 
the embodiment of this invention in Fig. 6. 

In Fig. 10, reference numeral 33 denotes a first 
robot side operator detector 33, and reference numeral 
34 denotes a second robot side operator detector 34. Both 
15 detectors are connected to an operator detection/control 
device 32. The operator detection/ control device 32 is 
connected to the first robot control device 22 and the 
second robot control device 27. 

Fig. 11 is a connection view of the operator detector 
20 control device 32 and its outskirts. 

The first robot side operator detector 33 is e.g. 
a safety mat. The first robot side operator detector 33 
has a contact 33-1 which is closed when the operator is 
present on the safety mat. The contact 33-1 is connected 
25 to the coil of a first operator detecting relay 62 of 
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the operator detect ion /control device 32 . Thus , when the 
first robot side operator detector 33 detects the operator, 
the operator detecting relay 62 is exited to turn on. 

Likewise, the second robot side operator detector 
5 34 is e.g. a safety mat. The second robot side operator 
detector 34 has a contact 34-1 which is closed when the 
operator is present on the safety mat. The contact 34-1 
is connected to the coil of a second operator detecting 
relay 64 of the operator detection/control device 32. 

10 Thus, when the second robot side operator detector 34 
detects the operator, the operator detecting relay 64 
is exited to turn on. 

The first robot control device 22 is connected to 
the coil of a first robot operable relay 61 of the operator 

15 detect ion/ control device 32 in such a manner that by 
manipulating the first pendant 23 with the driving power 
source for the first robot 21 being energized, an output 
signal 22-1 which is closed in the operable state of the 
first robot 21 is produced. Thus, if the first robot 21 

20 is in the operable state with the driving power source 
of the first robot 21 being energized, the first robot 
operable relay 61 is energized to turn on. 

Likewise, the second robot control device 27 is 
connected to the coil of the second robot operable relay 

25 63 of the operator detection/control device 32 in such 



47 



a manner that by manipulating the second pendant 28 with 
the driving power source for the first robot 26 being 
energized, an output signal 27-1 which is closed in the 
operable state of the second robot 26 is produced from 
5 the output unit 47-2. Thus, if the second robot 26 is 
in the operable state with the driving power source of 
the second robot 26 being energized, the second robot 
operable relay 63 is energized to turn on. 

In the operator detect ion/ contro 1 device 32, a 

10 series connection of a normally-opened contact 64-1 of 
the second operator detecting relay 64 and a 
normally-opened contact 61-1 of the. first robot operable 
relay 61 is connected to the coil of a second robot limiting 
relay 65. Further, a normally-opened contact 65-1 of the 

15 second robot limiting relay 65 is connected in parallel 
to the normally-opened contact 61-1 of the first robot 
operable relay 61 to constitute a protection circuit. 

Likewise, a series connection of a normally-opened 
contact 62-1 of the first operator detecting relay 62 

20 and a normally-opened contact 63-1 of the first robot 
operable relay 63 is connected to the coil of a first 
robot limiting relay 66. Further, a normally-opened 
contact 66 -1 of the first robot limiting relay 66 is 
connected in parallel to the normally-opened contact 63-1 

25 of the second robot operable relay 63 to constitute a 
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protection circuit. 

The other normally-opened contact 65-2 of the second 
robot limiting relay 65 is connected to the second robot 
control device 27. The other normally-opened contact 
5 66-2 of the first robot limiting relay 66 is connected 
to the first robot control device 22. 

An explanation will be given of the case where the 
first operator 29 enters the operating range of the second 
robot 26 in a state where the first operator 29 is operating 
10 the first robot 21 using the first pendant 23 and the 
second operator 30 is operating the second robot 26 using 
the second pendant 28. 

Since the first robot is being operated by the first 
operator 29, the first robot 21 is in the operable state 
15 or operating. In this state, the output 22-1 is closed 
so that the first robot operable relay 61 is energized 
to turn on. 

In this state, the second robot side operator 
detector 34 detects that the first operator 29 has entered 

20 the operating range of the second robot 26 or a dangerous 
region due to the operation of the second robot 26. Thus, 
the contact 34-1 of the second robot side operator detector 
34 is closed so that the second operator detecting relay 
64 is energized to turn on. 

25 Since the norma 1 1 y- opened contact 61-1 of the first 
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robot operable relay 61 and the normally-opened contact 
64-1 of the second operator detecting relay 64 are both 
closed, the second robot limiting relay 65 is energized 
to turn on. Thus, the other normally-opened contact 65-2 
of the second robot limiting relay 65 is communicated 
with the second robot control device 27. 

The second robot control device 27 receives the 
corresponding signal through the input unit 47-1. Since 
it is determined that there is the detected signal, the 
operation explained in the fourth to sixth embodiments 
will be carried out. 

The position monitoring and/or speed monitoring of 
the second robot 26 are continued while the 
normally-opened contact 65-2 of the second robot limiting 
relay 65 is closed. If the first operator 29 goes out 
from the operating range of the second robot 26 or the 
dangerous region due to the operation of the second robot 
26, the contact 34-1 of the second robot side operator 
detector 34 is opened and the normally-closed contact 
64-1 of the second operator detecting relay 64 is opened 
so that the second robot relay 65 is deenergized to open 
the normally-opened contact 65-2. Thus, the above 
position monitoring and/speed monitoring of the second 
robot 26 is released. 

Within the dangerous region due to the operation 
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of the second robot 26, if the first operator 29 interrupts 
the driving power source using an enable switch (not shown) 
included in the first pendant 23 of the first robot 21 
or through the operation of emergency stopping, the first 
5 robot 21 is placed in the non-operable state. Thus, the 
output signal 22-1 is opened so that the first robot 
operable relay 61 connected thereto is deenergized to 
turn off. However, because of the presence of the above 
protection circuit, the second robot limiting relay 65 

10 keeps its ON state while it is being energized. Thus, 
the position monitoring and/or speed monitoring of the 
second robot 26 is continued. 

If the second operator 30 enters the operating range 
of the first robot 21 or the dangerous region due to the 

15 operation o the first robot, the first robot side operator 
detector 33 detects this fact. Thus, the contact 33-1 
of the first robot side operator detector is closed so 
that the first operator detecting relay 62 is energized 
to turn on. 

20 In this case, the operator detection/control device 

32 carries out the operation corresponding to the above 
case where the first operator 29 enters the operating 
range of the second robot. The signal of the closing of 
the other normally-closed contact 66-2 of the first robot 

25 limiting relay 66 is supplied to the first robot control 
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device 22. Thus, the position monitoring and/or speed 
monitoring of the first robot can be made by the first 
robot control device 22. 

In this embodiment, the operator detection/control 
5 device 32 is explained with reference to a relay circuit. 
However, also where the signal corresponding to the robot 
limiting relay is supplied to the robot control device 
by the logical operation member such as a logic element 
or microcomputer, the same operational effect can be 
10 obtained. 

Further, where the number of robots in the robot 
system is increased, by preparing the operator detectors 
for the robots, the connection between the operator 
detection/control device and each robot control device 
15 and each operator detector, and the circuit of the operator 
detection/control device in the manner of position 
monitoring and/or speed monitoring required for the robot 
system can be easily changed. 

Since the operation of the robot to which the 
20 attention of the operator is not paid is limited through 
the configuration and operation described above, the 
operator can perform the teaching with great safety. 

In the embodiment described above, a single robot 
is combined with a single robot control device. However, 
25 where the single robot control device controls aplurality 
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of robots, it is needless to say that the position 
monitoring and/or speed monitoring for each robot can 
be made by preparing the position storage area, permitted 
value storage area and input unit for each robot in the 
robot control device. 

[ Industrial Applicability] 

This invention is usefully applied to a robot system 
and robot control apparatus in which the safety of workers 
is assured while a teacher performs working for a robot 
in a teaching playback system in access to the robot during 
his teaching. 




[Fig. 2] 

8: DETECTING DEVICE 

10: PENDANT 

11: SIGNAL PROCESSING UNIT 

12: LIMITED SPEED SELECTING UNIT 

13: TAUGHT DATA STORAGE AREA 

14: SPEED CALCULATING UNIT 

15: COMMAND CREATING UNIT 

16: DRIVING UNIT 

[Fig. 4] 

8: DETECTING DEVICE 

10: PENDANT 

11: SIGNAL PROCESSING UNIT 

12: LIMITED SPEED SELECTING UNIT 

14: SPEED CALCULATING UNIT 

15: COMMAND CREATING UNIT 

16: DRIVING UNIT 

17: ROBOT POSITION COMPUTING UNIT 

[Fig. 5] 

10: PENDANT 

12: LIMITED SPEED SELECTING UNIT 

14: SPEED CALCULATING UNIT 

15: COMMAND CREATING UNIT 



16 : 

17 : 



DRIVING UNIT 

ROBOT POSITION COMPUTING UNIT 



[Fig. 7] 

41: CONTROL UNIT 

43: CONTROL PROGRAM STORAGE MEMBER 
44: DATA STORAGE MEMBER 
44-1: POSITION STORAGE AREA 

44- 2: PERMITTED VALUE STORAGE AREA 

45- 1 : POSITION DETECTOR INTERFACE 
45-n: POSITION DETECTOR INTERFACE 
47-1 : INPUT UNIT 

Al : POSITION MONITORING SIGNAL 
47-2 : OUTPUT UNIT 

A2 : ABNORMALITY SIGNAL, WARNING SIGNAL 

48:' PENDANT INTERFACE 

49: DRIVING CIRCUIT INTERFACE 

50: DRIVING POWER SOURCE DEVICE 

51-1: DRIVING CIRCUIT 

51- n: DRIVING CIRCUIT 

52- 1 : MOTOR 

52- n : MOTOR 

53- 1 : POSITION DETECTOR 
53-n : POSITION DETECTOR 



[Fig. 8] 
Al : START 

STEP 1: THERE IS POSITION MONITORING SIGNAL ? 

A2 : NO 
A3: YES 

STEP 2: POSITION MONITORING SIGNAL RISES ? 

A4 : NORMAL 
A5: RISES 

STEP 3: STORE DETECTED POSITION IN DETECTOR IN 

POSITION STORAGE AREA 

STEP 4: COMPUTE POSITION DIFFERENCE BETWEEN DETECTED 

POSITION IN DETECTOR AND DETECTED POSITION STORED IN 
POSITION STORAGE AREA 

STEP 5: PERMITTED VALUE: POSITION DIFFERENCE 

STEP 6: STOP ROBOT 

A6: END 

[Fig. 9] 
Al : START 

STEP 11: THERE IS POSITION MONITORING SIGNAL ? 
A2 : NO 
A3: YES 

STEP 12: POSITION MONITORING SIGNAL RISES ? 
A4 : NORMAL 
A5: .RISES 



STEP 13: CALCULATE COORDINATE POSITION ON THE BASIS OF 

DETECTED POSITION IN DETECTOR 

STEP 14 : STORE COORDINATE POSITION IN POSITION STORAGE 
AREA 

STEP 15: CALCULATE COORDINATE POSITION ON THE BASIS OF 

DETECTED POSITION IN DETECTOR 

STEP 16: CALCULATE POSITION DIFFERENCE BETWEEN 
COORDINATE POSITION AND DETECTED POSITION STORED IN 

POSITION STORAGE AREA 

STEP 17: PERMITTED VALUE: POSITION DIFFERENCE 

STEP 18: STOP ROBOT 
A6: END 



